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© This invention relates to a method for setting tool center point for a robot that makes the setting of a tool 
center point possible accurately and simply without removing a tool from the robot. After a tool (50) is mounted 
to a tool mounting face (34), a tool center point (51) is set at the center (35) of the tool mounting face by a robot 
control device, and the robot is manually operated to position the tool center point at a reference point (61), 
teaching the state of this positioning. A matrix P1 is determined by the robot control device based on the 
^ teaching data. Next.the tool center point is set at a setting point (36) and the setting point is positioned at the 
O reference point by manual operation of the robot, teaching the state of this positioning. A matrix P2' is 
determined by the teaching data, and a transformation matrix TCP from a tool mounting face coordinates system 
(200) to a tool coordinates system (300) is further determined in accordance with an equation TCP = P1~ 1 .P2'. 
|N Or, a matrix P2 that shows the positioning state of the setting point at the reference point with the tool center 
**" point set at the center of the tool mounting face is determined, than the transforming matrix is determined in 
accordance with an equation TCP = P1~ 1 .P2.X using a matrix X showing the position and the attitude of the 
O setting point in the tool mounting face coordinates system. 
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TOOL CENTER POINT SETTING METHOD IN A ROBOT 

Technical Field 



The present invention relates to a tool center point setting method in a robot, and more particularly, to a 
method capable of accurately and easily setting the tool center point without the need of removing a tool 
5 from a robot. 



Background Art 



70 Generally, during a robot operation, the target position and orientation of a robot tool, which are stated 
in a program created beforehand on an off-line basis and are represented by an orthogonal coordinate 
system, are converted into target values of joint angles of individual axes of the robot, and the joint angles 
are respectively controlled to these target joint angles. In this coordinate system conversion, various 
transformation matrices are used for the coordinate conversion between adjacent ones of various coordinate 

15 systems set for various sections of the robot. For example, employed is a transformation matrix for the 
coordinate conversion from a coordinate system set for the tool mounting surface into a tool coordinate 
system. 

Conventionally, to determine the transformation matrix (i.e., to set the tool center point), at first, the 
distal end of a tool mounted to the tool mounting surface is positioned at a reference point whose 

20 coordinate position in a reference coordinate system is unknown, and a matrix P1" representing the position 
and orientation of the center of the tool mounting surface in the reference coordinate system at that time is 
derived. Then, after the tool is removed from the tool mounting surface, the center of the tool mounting 
surface is brought to the reference position, and a matrix P2" representing the position and orientation of 
the center of the tool mounting surface in the reference coordinate system at that time is derived. Assuming 

25 here that the transformation matrix is TCP" and an unknown matrix representing the coordinate position of 
the reference point in the reference coordinate system is P0", then the relationships represented by the 
following equations (1) and (2) stand between the matrices P0", P1" and TCP" and between the matrices 
P0" and P2", respectively. By eliminating the unknown matrix P0" from equation (1) using equation (2), the 
following equation (3) is derived. In equation (3), symbol P1"~ 1 represents the inverse matrix of the matrix 

30 P1'\ In this manner, according to the conventional method, the transformation matrix TCP" is derived in 
accordance with equation (3). 

PI" • TCP" - PO" 
P2" ^ PO" 

35 

TCP" = PI"* 1 ♦ P2" 

In an actual working site, however, it is sometimes impossible to remove the tool from the tool mounting 
4Q surface. In such a case, the conventional method cannot be used because it requires that the tool be 
removed to permit the center of the tool mounting surface to be positioned at the reference point. 

Another tool center point setting method which does not require the removal of a tool is also known in 
the art. According to the method proposed in Japanese Patent Application No. 62-229820, for example, the 
operation of determining the center of the tool mounting surface while holding the distal end of the tool 
45 mounted to the tool mounting surface at the reference point is carried out with respect to at least four 
different orientations of the robot while the robot orientation is being changed. Then, the position of the tool 
center point is determined on the basis of the coordinate position of the center of a sphere passing the at 
least four tool mounting surface centers thus determined. 

According to this conventional method, however, in order to determine the position of the tool center 
5Q point with a required accuracy, the operation of positioning the distal end of the tool at the reference point 
while the robot orientation is being changed must be repeatedly carried out a large number of times. This 
requires much labor. Moreover, the orientation of the tool cannot be determined. 
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An object of the present invention is to provide a method which is capable of accurately and easily 
setting the tool center point of a robot without the need of removing the tool from the robot. 

To achieve the above object, according to one aspect of the present invention, there is provided a tool 
center point setting method which comprises the steps of: (a) providing in a robot a set point whose position 
and direction relative to a center of a tool mounting surface are known; (b) providing a reference point in a 
robot installation space; (c) setting a tool center point at the center of the tool mounting surface, positioning 
the too! center point at the reference point, and teaching first position and orientation of the tool center point 
at that time; (d) setting the tool center point at the set point, positioning the set point at the reference point, 
and teaching second position and orientation of the tool center point at that time; and (e) deriving a 
transformation matrix on the basis of an inverse matrix of a matrix representing the first position and 
orientation, and a matrix representing the second position and orientation. 

According to another aspect of the present invention, there is provided a tool center point setting 
method comprising the steps of: (a) providing in a robot a set point whose position and direction relative to 
a center of a tool mounting surface are known; (b) providing a reference point in a robot installation space; 
(c) setting a tool center point at the center of the tool mounting surface, positioning the tool center point at 
the reference point, and teaching first position and orientation of the tool center point at that time; (d) 
positioning the set point at the reference point with the tool center point kept set at the center of the tool 
mounting surface, and teaching second position and orientation of the tool center point at that time; and (e) 
deriving a transformation matrix on the basis of an inverse matrix of a matrix representing the first position 
and orientation, a matrix representing the second position and orientation, and a matrix representing 
position and orientation of the set point in a coordinate system set for the tool mounting surface. 

As described above, according to the present invention, the transformation matrix including a tool 
orientation, i.e., the tool center point, can be accurately and easily set by merely teaching the tool center 
point assumed when the tool center point is positioned sequentlaJly at the reference point and the set point, 
or when the tool center point is set at the reference point and then the set point is positioned at the 
reference point. Accordingly, the robot operating performance such as tool path accuracy can be improved. 

Brief Description of the Drawings 



Fig. 1 is a schematic block diagram showing a robot to which a tool center point setting method 
according to a first embodiment of the present invention is applied; 

Fig. 2 is a schematic perspective view of a robot mechanism of Fig. 1 in a state wherein the distal end 
of a tool is positioned at a reference point (the distal end of a jig); 
35 Fig, 3 is a schematic perspective view of the robot mechanism in a state in which a set point is 
positioned at the reference point; 

Fig. 4 is a flowchart of a tool center point setting process executed by a robot control unit of Fig. 1; and 
Fig. 5 is a flowchart, similar to Fig. 4, showing a setting method according to a second embodiment of 
the present invention. 

40 

Best Mode of Carrying Out the Invention 



Referring to Fig. 1, a robot for embodying a tool center point setting method of a first embodiment of 
45 the present invention comprises a control unit 20, and a robot mechanism 30 for performing operations for a 
work object 40 under the control of the control unit 20. As shown in Figs. 2 and 3, the robot mechanism 30 
includes an arm 31 composed of a plurality of links (not shown) interconnected by means of joints (not 
shown), a wrist portion 32 mounted to the distal end of the arm, and servomotors (not shown) for individual 
axes. The wrist portion 32 includes a flange 33 secured at a distal end thereof, and a tool 50 is mounted to 
so the distal end face (tool mounting surface) 34 of the flange 33. Reference numeral 51 denotes the distal end 
of the tool as the tool center point. 

The control unit 20 is arranged to perform a coordinate conversion process, using various transforma- 
tion matrices, on the target position and orientation of the tool 50, which are stated in a program created 
beforehand on an off-line basis and are represented by an orthogonal coordinate system, thereby deriving 
55 target joint angles of respective axes of the robot, and is arranged to drive the servomotors of the individual 
axes of the robot mechanism 30 in accordance with these target joint angles, to thereby control the position 
and orientation of the tool 50. The robot mechanism 30 also includes various sensors (not shown) for 
detecting rotation angles (joint angles of the respective axes) of the servomotors for the individual axes. 
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A set point 36 (indicated by triangle mark in Figs. 2 and 3) is set at a predetermined portion of the robot 
mechanism 30, for example, at a predetermined position on the outer peripheral edge of the tool mounting 
surface 34. The direction of the set point 36 relative to the center 35 of the tool mounting surface and a 
distance between the set point and the center 35 (the position and orientation thereof in the coordinate 

5 system set for the tool mounting surface, described later) are known. Moreover, the set point 36 is set at 
such a portion that the set point can be positioned at the distal end 61 of a positioning jig 60, with the tool 
50 kept mounted to the tool mounting surface 34. In a robot installation space, the jig 60 may be provided 
at an arbitrary position on a robot installation floor 70, for instance. In this respect, the jig has its distal end 
(reference point ) 61 whose coordinate position in the reference coordinate system 100 may be unknown. In 

w Fig. 3, reference numerals 200 and 300 denote the coordinate system for the tool mounting surface and the 
tool coordinate system, respectively. These coordinate systems are set such that their coordinate origins 
respectively coincide with the center 35 of the tool mounting surface and the center of the distal end 51 of 
the tool, for example. 

Referring again to Fig. 1, the control unit 20 includes a central processing unit (hereinafter referred to as 

15 CPU) 21, a read-only memory (ROM) 22 storing a control program, and a random-access memory (RAM) 
23 for storing various data including teaching data, various calculation results derived by the CPU 21, etc. 
The control unit 20 further comprises a teaching pendant 24 including a teaching key (not shown) for 
teaching the robot, a manual data input unit (hereinafter referred to as a CRT/MDl) 25 with a display, an axis 
controller 26, and an interface 28, and is arranged to drivingly control the servomotors of the individual axes 

20 of the robot mechanism 30. The aforementioned elements 22 to 26 and 28 are connected to the CPU 21 via 
a bus 29, and various sensors (not shown) provided on the robot mechanism 30 and the work object 40 are 
connected to the interface 28. 

With reference to Figs. 1 to 4, the tool center point setting process executed by the robot constructed 
as mentioned above will be explained. 

25 After the tool 50 is mounted to the tool mounting surface 34 of the robot, an operator operates the 
CRT/MDl 25 to set the operation mode of the control unit 20 in a tool center point setting mode. At this 
time, a transformation matrix TCP (in this embodiment, each of the transformation matrix TCP and various 
matrices mentioned later is constituted by a homogeneous transformation matrix of 4x4) from the tool 
mounting surface coordinate system 200 to the tool coordinate system 300, employed for the aforemen- 

30 tioned coordinate conversion process, is provisionally set to a 4 X 4 unit matrix determined beforehand as a 
default value. Then, the same transformation matrix is stored in a predetermined address area of the RAM 
23. In other words, the tool coordinate system 300 is brought into coincidence with the tool mounting 
surface coordinate system 200. Namely, the tool center point (in this embodiment, the distal end 51 of the 
tool) is set at the center 35 of the tool mounting surface. 

35 During a robot operation in the tool center point setting mode, a first message "POSITION TOOL 
CENTER POINT AT REFERENCE POINT" is displayed on the CRT screen of the CRT/MDl 25 under the 
control of the CPU 21 of the control unit 20 (step S1), and the CPU 21 waits for an operation of the teaching 
key by the operator. In response to the first message, the operator operates the teaching pendant 24 to 
manually drive the robot so that the distal end 51 of the tool (tool center point) is brought to be coincident 

40 with the distal end of the jig, I.e., the reference point (Fig. 2), and then turns on the teaching key. When it is 
determined in step S2 that the teaching key has been turned on, the CPU 21 determines a matrix P1 
representing the position and orientation (first position) of the distal end 51 of the tool in the reference 
coordinate system in the thus positioned state, on the basis of the joint angles of the respective axes of the 
robot at that time and the transformation matrix TCP (the aforesaid unit matrix) at that time. This matrix P1 

45 is stored in a predetermined address area of the RAM 23 (step S3). Here, assuming that an unknown matrix 
representing the coordinate position of the reference point 61 in the reference coordinate system 100 is P0, 
then the following equation (4) is fulfilled. 

PI - TCP = PO . . . (4) 

50 

Next, in place of the unit matrix, the CPU 21 provisionally sets, as the transformation matrix TCP, a 
matrix X which is previously set and represents the position and orientation of the set point 36 in the tool 
mounting surface coordinate system 200 (step S4). In other words, the tool center point (the distal end of 
55 the tool) 51 is set at the set point 36. Then, the CPU 21 causes the CRT/MDl 25 to display a second 
message "POSITION SETTING POINT AT REFERENCE POINT" (step S5), and waits for an operation of 
the teaching key. In response to the second message, the operator manually operates the robot to bring the 
set point 36 to be coincident with the distal end 61 of the jig (Fig. 3), and then turns on the teaching key. 
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When this key operation is detected (step S6), the CPU 21 determines a matrix P2* representing the 
position and orientation (second position) of the distal end 51 of the tool in the reference coordinate system 
in the thus positioned state, on the basis of the joint angles of the individual axes at that time and the 
transformation matrix TCP (here, the aforesaid matrix X) at that time. Then, the matrix P2 1 is stored in the 
5 RAM 23 (step S7). In this case, the following equation (5) is fulfilled. 

P2' « P2 * X = PO ... (5) 

70 where symbol P2 denotes a matrix used in a second embodiment described later. 

Then, the CPU 21 determines the transformation matrix TCP in accordance with the following equation 
(6), derived from equations (4) and (5) and not including the unknown matrix PO, and causes the RAM 23 to 
store the matrix thus determined. Namely, the tool center point is set. 
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TCP = PI" 1 • P2* ... (6) 

where matrix P1" 1 is the inverse matrix of the matrix PI. 

During an actual robot operation to perform work onto the work object 40, the control unit 20 converts 
the target position and orientation of the tool 50 expressed in the orthogonal coordinate system Into target 
joint angles of the respective axes, using various transformation matrices including the transformation matrix 
TCP, and controls the robot mechanism 30 in accordance with the conversion results. 

Next, a tool center point setting method according to a second embodiment of the present invention will 
be explained. 

The second embodiment is similar to the first embodiment in that it can be carried out by the robot 
shown in Figs. 1 to 3 but different therefrom in that the transformation matrix TCP is derived in accordance 
with the below-mentioned equation (8) different from equation (6). 

With reference to Fig. 5, a tool center point setting process according to the second embodiment will 

be described. 

When the tool center point setting mode is set, steps S11 to $13 corresponding to steps $1 to S3 in 
the first embodiment are executed. That is, the tool center point is set at the center of the tool mounting 
surface and the first message is displayed, and then the matrix P1 representing the first position is 
determined in accordance with the key operation effected after the tool center point is positioned at the 
reference point. In this case, the aforementioned equation (4) is fulfilled. 

Then, unlike the first embodiment, the CPU 21 causes the second message to be displayed (step $14), 
without carrying out the setting (step $4) of the tool center point (the distal end of the tool) 51 at the set 
point 36, that is, with the tool center point kept positioned at the center 35 of the tool mounting surface. 
Then, when the teaching key Is turned on (step $15) after the robot is manually operated in response to the 
second message so that the set point 36 is positioned at the distal end of the jig (reference point) 61, the 
CPU 21 determines the matrix P2 representing the position and orientation (second position) of the tool 
center point 51 in the reference coordinate system in the thus positioned state, on the basis of the joint 
angles of the respective axes at that time and the aforesaid unit matrix, and causes the RAM 23 to store the 
matrix P2. At this time, the following equation (7) is fulfilled. 

P2 • X « PO ... (7) 

Next, the CPU 21 determines the transformation matrix TCP in accordance with the following equation 
(8) derived from equations (4) and (7). Namely, the tool center point is set. 

TCP =» PI • P2 • X . . . ( 8 ) 

This transformation matrix TCP is used for the robot control, as in the first embodiment. 

The present invention is not limited to the above-described first and second embodiments and various 
55 modifications thereof may be made. 

For example, in the above embodiments, the conversion from the tool mounting surface coordinate 
system to the tool coordinate system is represented by the homogeneous transformation matrix TCP of 
4x4, but an equivalent conversion may alternatively be used. Further, although in the above embodiments, 
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cases have been explained, wherein the tool point is provided to be coincident with the distal end of the 
tool, the present invention can be applied to a robot mounted with a tool whose tool point does not coincide 
with the distal end of the tool. Furthermore, in the above embodiments, the tool coordinate system whose 
coordinate origin coincides with the tool center point has been explained by way of example, but such 
5 setting of the tool coordinate system is not essential to the present invention. 

Claims 

to 1. A tool center point setting method in a robot, comprising the steps of: 

(a) providing in a robot a set point whose position and direction relative to a center of a tool 
mounting surface are known; 

(b) providing a reference point in a robot installation space; 

(c) setting the tool center point at the center of the tool mounting surface, positioning the tool center 
75 point at the reference point and teaching first position and orientation of the tool center point at that 

time; 

(d) setting the tool center point at the set point, positioning the set point at the reference point, and 
teaching second position and orientation of the tool center point at that time; and 

(e) deriving a transformation matrix on the basis of an inverse matrix of a matrix representing the 
20 first position and orientation, and a matrix representing the second position and orientation. 

2. A tool center point setting method according to claim 1, wherein said matrices representing the first 
position and orientation and the second position and orientation, respectively, are determined on the 
basis of joint angles of individual axes of the robot assumed at the time of teaching operations in said 

25 steps (c) and (d), respectively. 

3. A tool center point setting method according to claim 1, wherein said set point is provided at a 
predetermined portion of the robot at which the set point is permitted to be positioned at the reference 
point with a tool kept mounted to the robot. 

30 

4. A tool center point setting method according to claim 1, wherein a coordinate position of the reference 
point in a reference coordinate system is unknown. 

5. A tool center point setting method according to claim 1, wherein said setting of the tool center point at 
35 the center of the tool mounting surface is carried out by provisionally setting the transformation matrix 

to a unit matrix. 

6. A tool center point setting method according to claim 1, wherein said setting of the tool center point at 
the set point is carried out by provisionally setting the transformation matrix to a matrix representing 

40 position and orientation of the set point in a coordinate system set for the tool mounting surface. 

7. A tool center point setting method according to claim 1, wherein said tool center point is a distal end of 
a tool. 

45 8. A tool center point setting method in a robot, comprising the steps of: 

(a) providing in a robot a set point whose position and direction relative to a center of a tool 
mounting surface are known; 

(b) providing a reference point in a robot installation space; 

(c) setting a tool center point at the center of the tool mounting surface, positioning the tool center 
so point at the reference point, and teaching first position and orientation of the tool center point at that 

time; 

(d) positioning the set point at the reference point with the tool center point kept set at the center of 
the tool mounting surface, and teaching second position and orientation of the tool center point at 
that time; and 

55 (e) deriving a transformation matrix on the basis of an inverse matrix of a matrix representing the 

first position and orientation, a matrix representing the second position and orientation, and a matrix 
representing position and orientation of the set point in a coordinate system set for the tool mounting 
surface. 
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9. A tool center point setting method according to claim 8, wherein said matrices representing the first 
position and orientation and the second position and orientation, respectively, are determined on the 
basis of joint angles of individual axes of the robot assumed at the time of teaching operations in said 
steps (c) and (d), respectively. 

5 

10. A tool center point setting method according to claim 8, wherein said set point is provided at a 
predetermined portion of a robot at which the set point is permitted to be positioned at the reference 
point with a toot kept mounted to the robot. 

io 11. A tool center point setting method according to claim 8, wherein a coordinate position of the reference 
point in a reference coordinate system is unknown. 

12. A tool center point setting method according to claim 8, wherein said setting of the tool center point at 
the center of the tool mounting surface is carried out by provisionally setting the transformation matrix 

is to a unit matrix. 

13. A tool center point setting method according to claim 8, wherein said tool center point is a distal end of 
a tool. 
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FIG. 2 
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FIG. 4 
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FIG. 5 
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3 0 No squired additional search fees were timely paid by the applicant. Consequently, this international search report is restricted to 
the invention first mentioned in the claims: rt is covered by claim numbers: 

4 0 aM swchable claims could be searched without effort justifying an additional fee. the International Searching Authority did not 
invite payment of any additional fee. 

Remark on Protest 

j | The additional search fees were accompanied by applicant's protest. 

Q No protest accompanied the payment of additional search fees. 
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This International Searching Authority found multiple inventions in this international application as follows: 
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claims of the international sppltcation. 

2.H] As only some of the required additional search fees were timely paid by the applicant, this International search report covers only 
those claims of the international application for which fees were paid, specifically claims: 



3.(H No required additional search fees were tirnery paid by the applicant. Consequently, this international search report is restricted to 
the invention first mentioned in the claims; it is covered by claim numbers: 



4 -D 8,1 Kearcn > D,e claims could be searched without effort justifying an additional fee, the International Searching Authority did not 
invite payment of any additional fee. 
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lQ c,aim numbers . . because they relate to subject matter not required to be searched by this Authority, namely: 
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requirements to such an extent that no meaningful international search can be earned out. specifically: 



3 O c, *' m numbers because they are dependent claims and are not drafted in accordance with the second and third 

sentences of PCT Rule 6.4<a>. 
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This International Searching Authority found multiple inventions in this international application as follows: 



iQ As all required additional search fees were timely paid by the applicant, this international search report covers all searchable 
claims of the international application 

2 Q on *V *ome of the required additional search fees were timely paid by tha applicant, this international search report covers only 
those claims of the international application for which fees were paid, specifically claims: 

3 0 No required additional search fees were timely paid by the applicant Consequently, this international seerch report is restricted to 
the invention first mentioned in the claims; it is covered by claim numbers: 



4 0 A* 8,1 w«rch»ble claims could be searched without effort justifying an additional fee. the International Searching Authority did not 
invite payment of any additional fee. 

Remark on Protest 

Q The additional search fees were accompanied by applicant's protest. 

3 No protest accompanied the payment of additional search fees. 
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